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Abstract 



This paper considers the motion control of a particle and a spinning disc on rotating earth. The 
equations of motion are derived using Lagrangian mechanics. Trajectory planning is studied as an 
optimization problem using the method referred to as Discrete Mechanics and Optimal Control. 

1 Introduction 

This paper considers the motion control of a particle and a spinning disc on earth. In particular, we derive the 
governing equations using Lagrangian mechanics and study trajectory planning as an optimization problem 
using the method referred to as Discrete Mechanics and Optimal Control, see [4j [5] . 



Fi gure 1; The earth (oblate spheroid) is modeled as a rotating sphere with an added potential used to emulate the effect of 
the eccentricity which produces a non-zero horizontal component of gravity. 



1.1 Problem Description 

Consider the horizontal motion on earth in the absence of friction and pressure gradient forces. A perfect 
sphere model fails to capture the dynamical effects associated with the horizontal component of gravity due 
to the eccentricity of the earth, as shown in Figure [I] and discussed in [TJ [TUJ [TTJ [12] [13] for a particle moving 
on rotating earth. It also plays an important role in the unsteady dynamics of a spinning disc on rotating 
earth as investigated in [6j El [15] as a model for geophysical vortex motion. In both problems, the authors 
emulated the effect of the earth eccentricity by adding an artificial potential to the perfect sphere model. In 
this paper, we use the same model to address the problem of planning the motion on earth as an optimization 
problem based on a Lagrangian formulation. More specifically, we investigate optimal trajectories that steer 
the particle or the spinning disc from an initial position and velocity to a final position and velocity while 
minimizing a prescribed cost function such as the control effort. 



e 3 



ei 




i 



1.2 Motivation 



The main motivation for these problems comes from atmospheric sciences where one needs to track atmo- 
spheric drifters over periods of days, weeks, or even months. In the simplest case, these drifters are high 
altitude balloons which, to a first order approximation, can be thought of as passive tracers. However, if 
complex dynamical maneuvers are required, it is useful to include more complicated internal dynamics, such 
as rotational motion, which adds interesting new effects. These kinds of finite-dimensional models have also 
been used as mechanical models of vortex motion in some geophysical settings [6] and one could imagine 
thinking of the spinning disc model, in the limit as the ratio of the disc radius to the radius of the sphere 
goes to zero, as a "point-vortex", a collection of which might approximate a distribution of vorticity [8]. In- 
terestingly, systems of interacting rotating millimeter-sized discs floating on a liquid-air interface have been 
used recently [3 to study self-assembly of patterns in models that have some of the same pattern forming 
features as a wide range of vortex lattice systems. We consider the optimal control problems treated in 
this paper as a first step in the process of attempting to implement control and motion strategies in these 
contexts. 

1.3 Organization of the Paper 

In Section |2j we formulate the dynamics of a particle and a spinning disc moving on earth, and address the 
question of motion planning in Section [3] The numerical implementation and discussion of the results are 
presented in Section [4j 

2 Dynamics on Rotating Earth 

Consider a particle of mass m moving on a sphere of radius R and subject only to a gravitational force 
pointing towards the center of the sphere and a supporting force normal to the surface of the sphere (i.e., 
pointing in the opposite direction of gravity). One distinguishes two types of behavior relative to a fixed 
inertial frame {E^=i 5 2,3 as follows: if the initial velocity is zero, the particle remains at rest for all time, 
otherwise, it moves along a great circle which passes through the starting position and is tangent to the 
direction of the initial velocity at the starting point. If the sphere is rotating, say with an angular velocity 
vector ft = where Q — 27r/lday, the motion of the particle can be described relative to either a fixed 
inertial frame or a frame rotating with the sphere {e^ = i 5 2,3 with e3 = E3. In the inertial frame, one sees 
the same types of trajectories as in the stationary sphere case. The motion appears more complicated in 
the rotating frame where Coriolis and centrifugal forces need to be taken into consideration. An important 
observation here is that a particle starting at rest relative to the moving frame does not remain at rest due 
to the horizontal component of the centrifugal force, i.e., the component in the direction tangent to the earth 
surface. However, a particle starting at rest relative to the rotating earth remains at rest for all time. Indeed, 
in a more accurate model of the earth where the effect of eccentricity is taken into account, the horizontal 
component of the centrifugal force F cent is counterbalanced by the horizontal component of the gravitational 
force F^. Recall that F cent is given by: 

F C ent = -mftx(ftxR), (1) 

where R denotes the position vector of the particle on the sphere. It is convenient to introduce spherical 
coordinates ((/>, A) measured relative to the moving frame {e^}, see Figure [l] and an associated right-handed 
orthonormal basis {e^^ex^en}. The centrifugal force F cent can then be expressed as follows: 

Fcent = m R ^ 2 sin 4> (sin <fi e# + cos <fi e^) . (2) 

To cancel the horizontal component of F ce nt, the particle should be subject to a horizontal force opposite 
in direction and of magnitude equal to mRVt 2 sin <p cos <\>. One way to incorporate this effect yet retain the 
obvious advantages of spherical coordinates with constant radius is to introduce a potential function V a 
whose gradient in the horizontal direction produces such force, [13 , namely, 

V a = ^ mR 2 Q 2 sin 2 0. (3) 
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Figure 2: Free motion of a particle of mass m on a rotating earth and rotating sphere, the solid line is the trajectory on earth, 
dashed line is on sphere. End time is 3 days for all examples, initial conditions are: (a) (4>o,Xo) = (tt/4, 0), (<j>o,\o) = (0,2); 
(b) (0o, A ) = (3tt/8,0), (0o, A ) = (0.92,0); (c) (0 O ,A O ) = (3tt/8,0), (0 o ,A o ) = (1.366,0); (d) (</> ,A ) = (3tt/8,0), (</>o,A ) = 
(0, -2tt). 



2.1 Equations of Motion for a Particle 

The Lagrangian function for the system is given by: 

L(q,q)=T 



v, 



(4) 



where T and V denote the kinetic and potential energies, respectively, while q parameterizes the position 
of the particle on earth and can be chosen as q = ((/>, A). Lagrange's equations of motion are given by 
Hamilton's principle (also known as the least action principle). This principle amounts to taking variations 
of the action, between a fixed initial time to and a fixed final time 
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Ldt 



(5) 



with respect to arbitrary variations Sq of the path that keep the endpoints q(to) and q(tf) fixed. The 
point-wise equations of motion thus obtained are of the form: 



d dL dL 



= 0. 



dt dq dq 

The kinetic energy T of the particle can be expressed in terms of spherical coordinates as: 



T = - mR 2 
2 



</> 2 + (A + ^) 2 sin 2 



(6) 



(7) 



The potential energy is the sum of two parts, the gravitational potential V g which is a constant and therefore 
can be set to zero, and the artificial potential V a introduced in Lagrange's equations §6§ read as: 



A£7 sin 2<j) — - A 2 sin 2c 
A + 2(/>(A + ft)cot(/> = 0. 



0, 



(8) 



Finally, note that, since L is not an explicit function of longitude A and time t, by Noether's theorem, one has 
two integrals of motion (conserved quantities) associated with these symmetries. The angular momentum in 
the eA-direction is conserved, 



tt\ = mR z (\ + Q) sin 2 



and the total energy E is conserved 



E = -mR 2 



(/> 2 + (A + ft) 2 sin 2 



constant, 



-mR 2 Q 2 sin 2 6 = constant. 
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2.2 Equations of Motion for a Spinning Disc 

Consider a thin disc, of radius a and uniformly distributed mass m, tangent to the earth surface such that 
its center of mass lies on earth and can be parameterized by (0, A). The disc is free to rotate or spin about 
its axis of symmetry which, by assumption, remains normal to the earth surface at all time. That is, the 
disc is free to spin about the e^-axis. 

The Lagrangian function of the spinning disc is given by Q. The kinetic energy can be decomposed 
into a translation kinetic energy which has the same form as in Q and a rotational kinetic energy T rot , 
which can be expressed as: 

where I v = \mc? and Ih = \ma 2 are the moments of inertia of the disc about e# and about the horizontal 
axes and e^, respectively. In (J9|, the components of the angular velocity relative to the spherical basis 
{e^exien} are given by: 



uOcj) = </>, oj\ = (A + ft) sin 0, uj^ = ip + (A + ft) cos 4>. 
Now, use M = mR 2 , substitute (10) in ([9| and add Q to get the total kinetic energy 



(10) 



T=-(M + I h ) 



+ (A + n) 2 sin 2 



ip + (A + O) cos (f> 



(11) 



To simplify the expression for the potential energy, we assume that a <C R and treat the gravitational 
and artificial potentials, V g and V ai as functions of the center of mass only. In addition to V g and V a , the 
disc is subject to a potential function Vd of the form 
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Iy ft 2 COS 2 



(12) 



which, as V a , is due to the fact that the dynamics is described in a rotating frame. To better understand 
the potential Vd, consider the special case when the disc is stationary in inertial frame and its center of mass 
is placed at the north pole = 0. Clearly, relative to the rotating frame, the disc is not stationary and 
has total energy ^/ v ft 2 , which is exactly Vd\(/)=o- The total potential energy V = V g + V a + Vd can then be 
expressed as 

V = ift 2 (Msin 2 + / v cos 2 0), (13) 

where, as before, V g is constant and is set equal to zero. Lagrange's equations (|6| for the spinning disc, with 
q = (0, A, and I v = 21^ = 27, yield 



(M + I)4> = -2Iip(\ + ft) sin c 



(M - I) (A + ft) 2 - (M — 2/)ft 2 



sin 20, 



(M + J)A sin = 2Iip<j) - 2M(A + ft)0 cos 0, 

^ (M + I)$ sin cj) = -2Iip<j) cos + [M (1 + cos 2 (/>) + ! sin 2 0] (A + ft)0. 



(14) 



The Lagrangian function L does not depend explicitly on A, ^ and time t which implies the existence of 
three integrals of motion. The angular momenta tt\ and 7r^ in the and e# directions are conserved, 



tt\ = (M + /)(A + ft)sin 2 + 27 ^cos0+ (A + ft) cos 2 



constant, 



7T<0 = I v 

as well as the total energy 



ip + (A + ft) cos 



= constant, 



E : 



Mft 2 sin 2 



1 



+ -(M + J) ^ + (A + ft) 2 sin 2 



{[■ 



ip + (A + ft) cos 



ft 2 cos 2 ( 



constant. 
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Figure 3: Free motion of a spinning disc on rotating earth, the solid line is the result of direct numerical integration, dashed 
line is an approximate solution. We present <j>, A and ip in three columns respectively. Initial conditions and end times are: (a) 
(00, A ) = (tt/4,0), (<fio,\o,ipo) =.(0 5 0,H), end time 3 days; (b) (0o,A o ) = (tt/4,0), (<j>o , \o , ipo) = (0,0,10^), end time 3 days; 
(c) (0o, A ) = (tt/2 - 0.1,0), (<£o,Ao,^o) = (0,0,10ft), end time 15 days. 



An approximate solution to (14) can be sought under the assumption that the disc translational velocity is 
much smaller than the velocity of the earth, i.e. (j) <C £1 and A <C Q. The approximate solution, referred to 
as "steady drift" in [6 , is: 

0«0o, ip^iPo, (15) 

2 M cos 0n 



The comparison between this approximate solution and our direct numerical integration of (14) suggests 
that this is a good approximation under additional conditions (see Section [4] for more details). Namely, tp 
has to be much larger than £1, say of the order O(10Q). Also, it should be clear that the latitude (j) must 
not be chosen close to the equator where A obtained above is not accurate and the motions in <\> and ip are 
too significant to ignore. 



3 Motion Planning 

The main point of this article is to investigate the problem of motion planning for the particle and the 
spinning disc moving on earth. In the case of the particle, we introduce control forces in both and eA 
direction and solve for optimal control forces that steer the particle from an initial position and velocity 
to a desired final position and velocity. For the spinning disc, we apply a control torque about the axis 
of symmetry of the disc, i.e., a torque that controls the spin ip of the disc. Clearly, this spinning disc is 
under- actuated and questions of solvability and controllability are important. 

3.1 Solvability and Controllability 

The problem for the spinning disc is to find optimal torques that steer (0(£ o ), A(to), A(£o)) to (0(t/), A(t/), X(tf)) . 
For some given initial and final conditions, there may be no control torque that achieves the desired motion. 
In this case the optimization problem has no solution. 

In Section [4j we provide numerical evidence that the spinning disc can achieve a net motion on the 
earth surface under control mechanism. This suggests that the problem may be controllable or, at least, 
controllable in some finite regions of the earth surface. For a rigorous proof of controllability, one needs 
to appeal to controllability theorems for systems with drift, see, e.g., [9]. Such undertaken, although very 
important, is beyond the scope of the present paper. 

3.2 Motion Control as an Optimization Problem 

Take q to be the state variables and let / be the control force. For the case of a particle, one has q = (0, A) and 
/ = (fcpi fx) while for the spinning disc q = (</>, A, ip) and / = (0,0,/^). The motion planning problem can 
then be stated as follows. Given the boundary conditions q(to) = qo, q(to) = qo and q(tf) = g/, q(tf) — 
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Figure 4: Optimal control results of particle on rotating earth, the solid line is trajectory under control, and dashed line 
is equator. Initial and final conditions for case (a) and (b) are: (0o,Ao) = (tt/4, 0), (0o,Ao) = (0,0), (0/,A/) = (7r/4,7r/3), 
(<j)f,\f) = (0,0), and the end times: (a) tf =1 day, (b) £/=3 days. Initial and final conditions for case (c) and (d) are: 
(0 Oj A ) = (tt/3,0), (0o, A ) = (0,0), (0/, A/) = (tt/8,0), (0/, A/) = (0,0), and the end times: (c) =1 day, (d) t f =S days. 



find / that minimizes the cost function 



Jtn 



subject to the Lagrange-D'Alembert principle 

5 (' L(q,q)dt - 
Jt 



C(q,q,f) dt 



/ • Sqdt + p ■ 5q - p f ■ 5q f = 0, 



(16) 



(17) 



for all arbitrary variations Sq. That is, the least action principle outlined in Section [2] is restated here as the 
Lagrange-d'Alembert principle (to account for external control forces) and without the a priori assumption 
that the variations vanish at the end points to and tf. Rather, this condition is imposed using the boundary 
constraints 

Sqo q(t ) - q = , Sq f = q(t f ) - q f = 0, (18) 
and their associated Lagrange multipliers 



Po 



dL 
dq 



p f 



to 



dL 
dq 



(19) 



3.3 Discretization 



We discretize the optimal control problem using the novel method devised by [4 where the idea is to 
discretize the cost function (16) and the variational principle (17) directly using global discretization of 
the states and the controls. To this end, a path q(t), where t G [to?£f]? 18 replaced by a discrete path 
qd : {0, /i, 2ft, . . . , Nh = tf], N G N. Here, qd(nh) := q n is viewed as an approximation to q(t n = nh), n G N 
and n < N. Similarly, the continuous force / is approximated by a discrete force fd such that f n = fd(nh). 
The cost function (Tl6j) is approximated on each time interval [nh, (n + l)ft] by 



An+l)h 

Cd(q n ,qn+i,fn,fn+i)tt / C(q,q,f)dt, 

J nh 

which yields the discrete cost function 



(20) 



N-l 



Jd(qdifd) = ^2 Cd(qn,Qn+l,fn,fn+l)- 



(21) 



n=0 



The action integral (17) is approximated on each time interval [nh, (n + l)ft] by a discrete Lagrangian 

r (n+l)h 



r{n-\-L)n 

L d (q n ,q n+1 ) w / L(q,q)dt. 

J nh 



(22) 
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We also approximate J^ n+1 f ■ Sq ~ f n ■ Sq n + /+ • 5/ n +i, where f n and /+ are called left and right discrete 



torques, respectively. The discrete version of (17) requires one to find paths {q n }n=o sucn that f° r a ^ 
variations {Sq n }^ =0 , one has 



N-l N-l 



S Yl L d(Qn, q n +l) +^2(fn ' S Qn + fn ' $Qn+l) + PO ' $Q0 ~ p f ■ % = 0. (23) 



n=0 n=0 



The discrete variational principle (23) yields the following equality constraints 

' D 2 L d (q n - U q n ) + D 1 L d (q n , q n+1 ) + + /~ = 0, 

Po + 2?iid((/o,(Zi) + /o" = 0, (24) 
-P/ + D 2 L d (q N - 1 ,q N ) + = 0. 

4 Implementation and Numerical Results 

We now present some numerical results for free motion and motion planning of a particle and a spinning 
disc on earth. 

4.1 Direct Numerical Integration 

The free motion of a particle on rotating earth is shown in Figure [2] In order to illustrate the effect of the 
artificial potential V a , we integrated ([8| for V a = and for V a given in (|3| and plotted trajectories for the 
same initial conditions in Figure [2] The solid line corresponds to trajectories on earth while the dashed 
line is for trajectories on the sphere (V a = 0). The end time is 3 days in all examples. One can observe 
that due to the existence of V a , with some initial conditions (Figure |2ja)) the particle doesn't have enough 
momentum in the latitudinal direction to overcome the peak of V a on the equator, therefore the trajectories 
are constrained within one hemisphere, while the trajectories on the sphere always cross the equator when 
</>o 7^ 0. In Figure [^b), the trajectories asymptotically approach the equator. In Figure [2jc), the trajectories 
appear to have an "8" shape and the cross point is always on the equator (also mentioned in Paldor and 
Sigalov [H]), note this is also observed in the sphere model but with different initial conditions. Note that, 
since the motion on earth is actually motion on a sphere under a potential V a , the trajectories are similar 
to those of a spherical pendulum, see Figure [2^d). Here, for the same initial conditions, the particle under 
no potential (V a = 0) moves along a latitudinal circle. 



Equations (14) for the free motion of a spinning disc on earth are integrated numerically and the 
results are shown in Figure [3J All examples are chosen to have zero initial translational velocity, which in 
the particle case will lead to a station ary state for all time. By comparing all three sets of initial conditions, 



we affirm our conclusions in Section 



2.2 



on the validity of the approximate solution. Namely, if ip is too 
small (Figure^ a)), the "steady drift" velocity is not as good an average of A as the case where tp is larger 
(Figure |3jb)). If the motion takes place near the equator (Figure [3jc)), oscillations in all directions become 
too large to be ignored. 

4.2 Implementation of the Optimization Problem 

We employ the mid-point approximation to obtain the discrete quantities in Section [3j The cost function is 
a measure of total control effort, defined by 

J= f\fl + fl)to, J - P $dt, (25) 

J t Jt 



for the particle and the spinning disc, respectively. The left and right discrete forces are approximated by 



f n = f '+ = + in+i) and the discrete Lagrangian is given by 



L d (q n ,q n+1 ) = hL( , . (26) 
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Figure 5: Optimal control results of the spinning disc on rotating earth. In the first row, we show trajectories in solid line 
and the equator in dotted line. In the second row, we present the spinning velocities correspondingly. End time is 3 days 
for all examples. Initial and final conditions are: (a) (</>o,Ao) = (tt/4, 0), (4>o , \o , ipo) = (0,0,10ft), (</>/, A/) = (7r/4, 0.1), 
(<j>f,\f,ii> f ) = (0,0, lOfi); (b) (0o, A ) = (tt/4,0), (0o,A o ,^o) = (0,0, ft), (0/,A/) = (7r/4,7r/3), (<f>f,\f,i>f) = (0,0, ft); (c) 
(00, A ) = (tt/4,0), (0o,A o >o) = (0,0,10ft), (</>/, A/) = (7r/4,7r/3), (<j>f,\ f ,ij>f) = (0,0,10ft). 



The discrete cost function for the particle is of the form 



Jd 



N ~ 1 u 

En 

n 4 

n=0 



[(U l) + (/A,n + f\,n+l) ] 



while that for spinning disc is 



N-l 



n=0 



(/0,n + /^,n+l) 2 - 



(27) 



(28) 



The solution procedure is as follow: (i) guess the trajectory for a small number of discrete steps, often 
the geodesic connecting starting and ending positions; (ii) solve the discrete optimization problem using 
sequential quadratic programming (SQP) method to obtain optimized trajectory and cost, done in Matlab; 
(iii) use result in (ii) as a reference in generating initial condition for more discrete steps, repeat (ii); (iv) 
compare the results, if the difference is small enough, numerical solution is obtained, otherwise repeat (iii). 



4.3 Numerical Results of Motion Planning 

The results for particle motion under optimal control are shown in Figure [4] Initial and final velocities are 
set to be zero for these simulations. Clearly, the optimal trajectories depend not only on the initial and final 
conditions but also on the time period tf — to. In Figures j4^a) and|4|c), the time period is 1 day while the 
trajectories in|4jb) and[4^d) correspond to the same initial and final conditions but with a time period equal 
to 3 days. In order to arrive at final positions on time for[4jb) and|4^d), the particle must travel further, 
while for |4ja) and |4jc) the trajectories are obviously shorter. Yet the shorter trajectories come with the 
price of larger control efforts, Jd\ a = 66.2, Jd\b — 23.4, Jd\ c = 54.7 and Jd\d = 14.3, which can be interpreted 
physically as follows: although the particle in[4jb) and[4^d) cover more distance, the fact that it has more 
time to reach its final destination means that it can better exploit the rotation of the earth. 

The examples for a spinning disc under optimal control are shown in Figure [5j The first row illustrates 
the trajectories while the second row shows the corresponding spinning velocities tp. The initial and final 
conditions are: 0o = = 7r/4, Ao = 0, and Xf are chosen to be 0.1, 7r/3 and 7r/3 respectively, also 
<j>o = Ao = 4>f = Xf = 0, and ?po = ipf are chosen to be 10^, Q and 10f2 respectively. Since the control 
torque is only applied in ijj direction, the disc is under-actuated and motion planning is harder than in the 
particle case. Comparing [5| a) with|5|c), one can observe that the trajectories have very similar behavior 
in the first half period. However, in the second half period, in order to travel further in^c), ip needs to 
be increased more than that in [5^ a), i.e. the control effort needs to be larger. Meanwhile, trajectories in 
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[5^b) and[5|c) have similar behavior in the second half period, yet in the first half, the trajectories are quite 
different because of the different initial conditions. It is important to note that these examples result in net 
latitudinal changes. A net longitudinal motion seems not to be achievable by applying a control torque in ip 
only. This issue will be investigated in future work. 

5 Summary 

The motion planning for a particle and a spinning disc on earth was considered using an optimal control 
approach. These models are relevant for understanding geophysical vortex motion as well as for controlling 
the motion of atmospheric drifters such as high altitude balloons. In this paper, we employed an existing 
model of earth as a perfect sphere with an additional potential, then derived the equations governing the 
motion of a particle and a spinning disc moving on earth using Lagrangian mechanics, and showed solutions 
using direct numerical integration. We also examined the steady drift obtained in [6], and gave conditions 
for its validity. Motion planning for the particle and spinning disc was examined using discrete mechanics 
and optimal control. Rigorous proof of controllability of the spinning disc via one control torque about its 
spin axis remains an open question to be addressed in future work. Future directions include application of 
the earth model and the control methods used in this paper to the problem of multiple vortices on a sphere 
discussed in [8]. 
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